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Positional deviations of freely programmable manipulators such as, e.g. industrial robots, which are used for 
demanding manipulatory tasks can be compensated only if they are known in temis of magnitude and direction. 
The measuring device described pemnits detemiinatlon of the positional accuracy of such units in all six degrees 
of fireedom (position and orientation) during the execution of a preprogammed movement by the manipulator It is 
also possible to measure speeds and accelerations of the manipulator in the direction of the executed movement 
by means of a combination of measurements of distance and time. In addition, because of Its measuring principle 
the measuring device described is eminently suitable for computer-aided recording and evaluation of measured 
values. 
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Positionsabweichungen von frei programmierbaren 
Handhabungsgeraten, wie z. B. Industrierobotem, die ffir 
anspruchsvolle Handhabungsaufgaben eingesetzt warden, 
konnen nur dann kompensiert werden, wenn sia der Gro&e 
und Hichtung nach bekannt sind. Die beschriebene Me&ein- 
richtung eriaubt eine Bestimmung der Positioniergenauig- 
kett solclier Gerate in alien sechs Freiheitsgradan (Position 
und Orientierung) wahrend der Ausffihrung einer vorpro- 
grammlerten Bewegung durph das Handhabungsgerat. 
Auch Gaschwindigkeiten und Beschleuntgungen des Hand- 
habungsgeriBtes in Richtung der ausgefuhrten Bewegung 
k5nnen mittels einer Kombination von Abstands- und Zeit- 
messung erf a &t warden. 

Daruber hinaus ergnet sicti die beschriebene l\ieSeinrich- 
tung aufgrund ihres IVIe&prinzlps in vorzuglicher Weise fur 
computerunterstutzte MeSwertaufzeichnung und Auswer- 
tung. 
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Patent an s p rueche ; 



1. Messeinrichtung zur Bestimmung der Posltioniergehaui gkeit 
von f rei programmi erbaren Handhabungsgeraeten in Position 
und Orientierung waehrend der Ausfuehrung einer vorprogram- 
mierten Bewegung durch das Handhabungsgeraet , 

dadurch gekennzei chniet, dass sechs voneinander unabhaengige 
Messignale durch sechs in geeigneter Anordnung befindliche 
Messwertauf nehmer auf gezei chnet werden, die von dem zu 
vermes senden Handha bungs geraet rel at i v zu einer Schablone 
bewegt werden, welche die Idealkontur der gewuenschten 
Bewegung verkoerpert . 



2, Messeinrichtung hach Anspruch 1, 

dadurch gekennzei chnet , dass eine Information ueber die 
Posf tionskoordinate in Richtung der ausgef uehrten Bewegung 
dadurch gewonnen wird, dass durch einen geeigneten 

Sensbr Messimpulse ausgeloest werden fuer Zei tmessungen 
zwischen jeweils zwei aufeinander fotgende Marki erurigen , 
die in regelmaessigen Abstaenden auf der Schablone ange- 
ordnet sind; mit Kenntnis der gemessenen Zei t i ntervall e 
koennen Geschwindigkeiten und Beschleuni gungen in Richtung 
der ausgef uehrten Bewegung berechnet werden. 
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Beschrel bung 



MESSEINRICHTUNG ZUR BESTIMMUNG DER POSITIONIERGENAUIGKEIT VON 
5 FREI PROGRAMMIERBAREN HANDHABUNGSGERAETEN. 

S^^. ^r^^'?<'"'^9 betrifft eine Messei nrl chtung zur Bestimmung der 
PositTomergenauigkeTt von frei' programmi erbaren Handhabungs- 
geraeten nach dem Oberbegrlff des Anspruchs 1. 

10 

Fuer zunehmend anspruchsvollere Einsatzaufgaben frei program- 
mlerbarer Handhabungsgeraete wie z. B. Industrieroboter \st 
. eine genaue Kenntnis ihres Posit? oni erverhaTtens im dreidimen- 
sionalen Raum von entscheldender Bedeutung. Dies ~ gilt 
15 insbesondere fuer solche Anwendungen, die praezise geradlinige 
Bewegungen der Handhabungsgegenstaende (Greifer, Werkzeuge, 
Bauteile) erfordern, z, B. beim Lichtbogenschweissen, Jet 
Cutting, Laser-Handhabung oder Fuegen und Montage. Eine 
_ vollstaendige Beschreibung der Position eines Gegenstandes im 
20 dreidiraensionalen Raum liegt vor, wenn die Positiohskoordina- 
ten Mnd die Orientierungswinkel dieses Gegenstandes bekannt 
sind (sechs Freiheitsgrade) . 

Messanordnungen, die sowohl Position wie Orieritierung eines 
25 Handhabungsgeraetes erfassen, sind bekannt fuer die Bestimmung 
der Positionsgenauigkeit und Wiederholgenauigkeit in einzel- 
nen, diskreten Positionen. Messanordnungen hingegen, die auch 
fuer in Bewegung befindliche Handhabungsgeraete zur Bestimmung 
der Positioniergenauigkeit geeignet sind, erfassen ueblicher- 
30 weise wen7ger als sechs Messkoordinaten, die zur Positions- 
bestimmung herangezogen werden koennen (Warnecke, H.J;, 
?^oo^t^' Industrial Robots: Application Experience, 

1982 I.F.S. Publications Ltd., S. 63-92 ; Deutsche Ausgabe: 
Industrieroboter. Krausskopf Verlag GmbH, Mainz 1979). 

35 . 

Der Erfindung liegt die Aufgabe zugrunde, die Positionierge- 
nauigkeit frei programralerbarer Handhabungsgeraete in alien 
sechs Freiheitsgraden (Position und Orientierung) waehrend der 
Ausfuehrung einer vorprogrammierten Bewegung zu erfassen. 
40 Diese Aufgabe wird erfindungsmaessig durch die kennzei chnenden 
Merkmale des Anspruchs 1 geloest. 

Eine Teilaufgabe dabei ist die Erfassung der Posi tionskoordi - 
nate in Richtung der ausgef uehrten Bewegung, die insbesondere 
be7 grossraeumigen Bewegungen nur schwer zu ermitteln ist. 
45 Diese Aufgabe wird erfindungsmaessig durch die kennzei chnenden 
Merkmale des Anspruchs 2 geloest. 

Die mit der Erfindung erzielten Vorteile bestehen darin, dass 
dem Anwendef eines frei programmi erbaren Handhabungsgeraetes 
50 mittels der hier beschri ebenen Messei nrichtung eine detailier- 
te Kenntnis des Positionierverhaltens in alien sechs Frei- 
heitsgraden vermittelt werden kann. die wichtige Aufschluesse 
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ueber Moegl ichkei ten und Grenzen dieses Handhabungsgeraetes 
zulaesst, bevpr efne El nsatzentscheldung getroffen werden 
muss . 

Naturgemaess muessen waehrend eines Testlaufes eine grosse 
5 Anzahl von Messwerten in schneller Folge abgelesen und gespel- 
chert werden, wenn statfstisch zu verlaessi ge Testergebni sse 
gefordert sfnd. Ei ne wi rkungs vol! e Auf zei chungsmethode ist 
deshalb prakttsch nicht zu verwirklichen, ohne sich der Hilfe 
von Computern zu bedienen. Deshalb ist als weiterer Vopteil zu 

10 betrachten, dass sfch die beschriebene Messeinrichtung in vor- 
zueglicher Weise fuer computerunterstuetzte Messwertauf nahme 
und Auswertung eighet. So kann beispielsweise der durch die 
Markierungen auf der Schablone- hervorgeruf ene Messimpuls 
gemaess Anspruch 2 nicht nur fuer Zei tmessuhgen genutzt 

15 werden, sondern gl eichzei tig auch zum Triggern der Messwert- 
uebergabe der uebrigen Messwentaufnehmer . Bei dieser Vor- 
gehensweise werden die zugeordneten Messwerte verschi edener 
Testlaeufe - grundsaetzl i ch an demselben Messort auf gezei chnet, 
gegeben durch die Position der jeweiligen Mapkierung auf der 

20 Schablone. Eine Abhaengi gkeit des Messortes von Schwankungen 
in der Bewegungsgeschwindigkeit des Handhabungsgeraetes wird 
somit weitgehend ausgeschal tet . 



J< 3526919 

Ein Ausfuehrungsbeispiel der Erfindung 7st in Fig* 1 darge- 
stellt und wird im folgenden naeher beschrieben. 

Bel der ausgef uehrten Messeinrichtung nach Fig. 1 werden als 
5 Messwertaufnehmer fuenf induktive, analoge Abstandsmessep und 
. ein digitaVer Inf rarot-Sensor verwendet, montiert in einem 
integrierten Messkopf. Drei der induktiven Abstandsmesser (Xl* 
X2, X3) sind in einer Ebene des Messkopfes angeordnet fuer die 
Ermittlung der X-Koordinate und der Winke] /3 und jr . die 
10 uebrigen beiden (Yl, Y2) sind in einer zweiten Ebene recht- 
winklig zur ersten angeordnet fuer die Ermittlung der Y- 
Koordinate und des Winkels cL . Als Ref erenzschabl one dient ein 
U-Stahl , dessen Seiten exakt geradl i ni g und rechtwi nk 1 i g zu- 
einander geschliffen sind. Als optische Markierung dient ein 
.15 Aluminiumstreifen. der auf dem U-Stahl montierl: ist und eine 
Vielzahl von in gleichen Abstaenden ei ngef raesten Nuten auf- 
weist. 

Wird nun der Messkopf, angeflanscht an das zu untersuchende 
20 Handhabungsgeraet, in etwa gl ei chbl ei bendem Abstand ueber dJe 
Schablone gefuehrt (wobei maximaler und minimaler Abstand 
durch den Messbereich der induktiven Abstandsmesser bestimmt 
werden), schaltet das Ausgangssignal des Infrarot-Sensors bei 
jedem Passieren einer Nutkante von 'High* zu 'Low* Oder umge- 
25 kehrt. Wird di e. Zei tspanne zwischen jedem Wechsel gemessen und 
auf gezeichnet , koennen Geschwfndi gkei ten urid Beschl eun i gungen 
in Richtung der Z-Koordinate leicht berechnet werden, da 
Nutenabstand und Nutenweite (AZ) bekannt sind. Das gleiche 
Signal wird weiterhin dazu verwendet, die Uebergabe der 
30 induktiv erfassten Abstandsmesswerte zu triggern und jeweils 
drei AX-Werte und zwei AY^Werte auf zuzei chnen . 

Infolge der rechtwi nkl i gen Anordnung der Messwertaufnehmer 
koennen die auf gezei chneten Relativwerte leicht in die Koordi- 
35 naten des ortsfesten X, Y, Z, <X , /3,jf« Koordi natensy stems , 
transformiert werden, das mit der Ref erenzschabl one verbunden 
ist. 

(Ein prototypisches Messystem, das nach dem hier beschri ebenem 
40 Prinzip verwirklicht worden ist, hat die folgenden Kenndaten: 
Nutzbare Messlaenge des U-Stahls 1000 mm, Nutabstand 2,5 mm, 
Nutweite 1,25 mm, Abstandsberei ch de r induktiven Messwertauf- 
nehmer 2 mm bis 10 mm, maximale Bewegungsgeschwi ndi gkei t des 
Messkopfes 1000 mm/sec, Aufloesung des A/D-Wandlers 0,01 mm. 
45 Messwertaufnahme und Auswertung werden durch einen handels- 
ueblichen Micro-Computer ausgefuehrt, der zu diesem Zweck mit 
einem geei gneten Data-Acquisition-Board ausgestattet ist.) 
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Fig. 1: Prinzipskizze der Messeinrichtung 
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